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Procede et disposltif pour la detection et la localisation d'obstacles dans renvfronnement d'un vehicule. 



(57) L'invention conceme un procecie de detection et de lo- 
calisation d'obstacles dans renvlronnement d'un vehicule. 
A cet effet, il comprend les etapes consistant a emettre des 
signaux en direction dudlt environnement a partir d'une plu- 
ralite de radars (2) disposes sur fe vehicule, a deduire des 
signaux recus en echo les probabilites d'occupation par un 
obstacle d'un ensemble de cellules elementaires (9) dudit 
environnement, et a fusionner ies probabilites relatives a 
chacune desdites cellules. 
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A 

Procede et dispositif pour la detection et la localisation 
d'obstacles dans I'environnement d'un v£hicule 

La presente invention concerne un precede et un dispositif pour la detection et 
5 la localisation d'obstacles situes dans I'environnement d'un vehicule arrete ou 
en mouvement. 

Une fonction importante de la robotique mobile concerne la detection des 
objets ou obstacles situes au devant ou sur le cote du vehicule porteur, dans la 
10 mesure ou ceux-ci peuvent entraver son mouvement et doivent etre 
contournes, ou necessitent son arret complet par souci de securite ou, au 
contraire, sont suffisamment distants ou dans une direction telle que le 
vehicule peut continuer son chemin sans ecart. ' 

is Un aspect secondaire de cette detection consiste a exploiter une connaissance 
a priori du positionnement (absolu) de I'objet detecte par rapport a une carte ou 
un site plus vaste, pour qu'en detectant cet objet et en mesurant ses 
coordonnees (site et distance) on puisse en retirer une information sur la 
position absolue du vehicule lui-meme. 

20 

Un moyen commode pour detecter des objets situes dans la peripherie d'un 
vehicule et permettant d'en mesurer les coordonnees consiste a utiliser des 
capteurs a ultra-sons. 

25 Selon cette technologie bien eprouvee, une onde acoustique est emise 
periodiquement et, se trouvant reflechie par les objets constituant des 
obstacles a sa propagation, revient vers le capteur apres un temps de retard, 
lequel depend directement de la distance de Tobjet ainsi detecte. 

30 Pour assurer la detection peripherique d'un vehicule, il convient de disposer un 
nombre suffisant de tels capteurs sur son pourtour en fonction de Tangle 
d'ouverture du capteur elementaire. Ce nombre est d'autant plus eleve que les 
capteurs auront un lobe de detection etroit. 

35 L'utilisation de ces capteurs fournit une information de distance par rapport a 
un obstacle, mais I'information d'orientation angulaire est d'autant moins bonne 
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que les capteurs sont a lobe large. En effet, dans la mesure ou un capteur voit 
un obstacle donne non pas en un point de I'espace mais de maniere ambigue 
en tous points situes a egale distance, si Ton associe plusieurs capteurs pour 
assurer la couverture du perimetre du vehicule, redetermination de la position 
5 angulaire des obstacles detectes peut etre excessivement grande. 

A contrario, une detection plus fine exige un nombre superieur de capteurs 
elementaires, a lobes plus etroits, ce qui accroTt le cout global de la detection. 

io Un autre inconvenient de I'utilisation de capteurs a ultra-sons est leur tres 
grande sensibilite aux perturbations acoustiques exterieures, aux anomalies de 
reflexion sur certains obstacles, ainsi que la sensibilite au vent des ondes 
sonores, Techo pouvant meme etre souffle et ne jamais revenir a sa source. 

15 La presente invention vise a pallier ces inconvenients. 

A cet effet, I'invention a tout d'abord pour objet un procede de detection et de 
localisation des obstacles situes dans I'environnement d'un vehicule, 
caracterise par le fait qu'il comprend les etapes consistant a emettre des 
20 signaux en direction dudit environnement a partir d'une pluralite de radars 
disposes sur le vehicule, a deduire des signaux re^us en echo les probabilites 
d'occupation par un obstacle d'un ensemble de cellules elementaires dudit 
environnement, et a fusionner les probabilites relatives a chacune desdites 
cellules. 

25 

Des algorithmes de fusion d'informations sont deja connus dans la technique. 
Toutefois le fait de fusionner des probabilites ^occupation de cellules 
elementaires, ces probabilites etant elles-memes obtenues a partir de signaux 
radar, peut donner, avec la technique selon I'invention, des resultats tout a fait 
30 surprenants par leur precision, permettant meme la cartographie des obstacles 
detectes et rendant done possible leur evitement ainsi que la localisation du 
vehicule lui-meme, du fait de la grande qualite de la modelisation de 
Tenvironnement ainsi effectuee. 

35 Par ailleurs, contrairement aux capteurs a ultra-sons, les radars peuvent etre 
utilises en exterieur et par tout temps. 
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Enfin on a pu constater que I'invention permet meme d'utiliser des radars de 
performance individuelle relativement mediocre sans alterer les resultats de la 
modelisation globale. 

5 

Dans un mode de realisation de I'invention, la fusion est effectuee sur les 
valeurs des probabilites fournies par une pluralite de radars, et notamment 
deux radars. 

io Dans ce cas, la fusion est effectuee de maniere spatiale de maniere a associer 
des donnees retournees simultanement par un sous-ensemble de radars ayant 
detecte un meme obstacle sous des angles differents. 

Dans un autre mode de realisation, la fusion est effectuee sur la valeur de la 
15 probability fournie par un radar et la valeur de la probability anterieurement 
connue pour la meme cellule. 

La fusion est dans ce cas effectuee de maniere temporelle, le meme obstacle 
etant vu successivement par un meme capteur qui aura avance en meme 
20 temps que le vehicule. Dans ce cas, Poperation de fusion est appliquee a la 
valeur deja affectee a la cellule. 

On peut deduire des signaux re<jus en echo une information de distance et une 
information angulaire sur les obstacles et determiner lesdites probabilites 
25 d'occupation a partir de ces informations. 

De preference on prevoit une etape de seuillage des resultats de la fusion de 
maniere a obtenir une carte depouillee des artefacts divers pouvant provenir 
de reflexion speculates ou multiples, des ondes radars emises. 

30 

Selon un mode de realisation particuliere de Tinvention, le signal emis par les 
radars est module en frequence, le signal regu en echo est melange a une 
fraction du signal emis pour, apres elimination de la frequence porteuse, former 
un signal de battement, et les impulsions de battement sont comptees pendant 
35 un intervalle predetermine pour fournir la distance d'un obstacle. 
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En variante, cette distance peut etre fournie par transformation de Fourrier. 

Avantageusement, remission de chaque radar dare un temps lirnite et la 
logique de repetition peut meme etre codee en vue de r identification de la 
source. 

^invention a egalement pour objet un dispositif pour la modelisation de 
I'environnement d'un vehicule, caracterisee par le fait qu'il comprend une 
pluralite de radars montes sur le vehicule et une unite de traitement agencee 
pour fusionner les donnees fournies par les radars. 

Grace a I'operation de fusion, on peut sans inconvenient choisir des radars a 
lobe large, done de performance moyenne et de'eout peu eleve. 

On observera que les radars de ce type, notamment les radars Doppler 
courants, sont generalement utilises en mesure de vitesse alors qu'ici, e'est la 
distance qui est mesuree a titre principal, la mesure de vitesse n'etant 
eventuellement utilisee qu'a titre accessoire. De surcroit, alors que les radars 
utilises en vue de mesures de distances sont generalement des radars 
fonctionnant en impulsions, on utilise ici de preference des radars a emission 
continue et fonctionnant en modulation de frequence. 

On decrira maintenant a titre d'exemple non limitatif un mode de realisation 
particulier de Tinvention, en reference aux dessins schematiques annexes dans 
lesquels : 

- la figure 1 est une vue schematique de dessus d'un vehicule muni des 
moyens de ('invention, 

- la figure 2 est un diagramme fonctionnel de ces moyens, 

- la figure 3 illustre les signaux emis par les radars, 

- la figure 4 represente la modelisation de I'environnement du vehicule, 
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- la figure 5 illustre la fonction de repartition des probabilites d'occupation d'une 
cellule par un obstacle en fonction de la distance au foyer d'une antenne et 

- la figure 6 illustre la fonction de repartition des probabilites d'occupation de 
cette cellule en fonction de I'ecart angulaire entre sa direction et Paxe de 
I'antenne. 

La figure 1 represente un vehicule automatique muni d'une plate-forme 1 sur 
laquelle sont montes une pluralite de radars 2, par exemple une vingtaine. Les 
radars 2 sont ici des radars a lobe large, c'est-a-dire d'angle d'ouverture 20 
typiquement compris entre 15° et et 120°. On rappelle qu'un angle 20 important 
est recherche pour obtenir une bonne couverture peripherique autour du 
vehicule avec un nombre de capteurs aussi reduit que possible. 

Les radars 2 sont ici des radars FMCW a modulation de frequence et a 
emission continue ou par fenetre temporelle. 

Les radars 2 sont places a la peripherie du vehicule de maniere a obtenir une 
vision aussi complete que desiree de son environnement. La finesse de la 
couverture de detection et de la modelisation en general, depend directement 
du nombre de radars utilises dont les lobes individuels peuvent se rejoindre 
arbitrairement comme cela est repesente vers I'avant (fleche 3) et le cote du 
vehicule. 

On voit sur la figure 2 trois des antennes radars 2a, 2b et 2c. Chacune de ces 
antennes est reliee par I'intermediaire d'un circuit d'inteface 4a, 4b ( 4c 
respectivement, a une unite 5 susceptible d'elaborer les signaux de 
declenchement Sa f Sb et Sc respectivement des radars. En variante, les 
signaux de declenchement peuvent etre communs a tous les radars. 

Les signaux Sa, Sb, Sc sont modules en frequence comme represente a la 
figure 3. Une frequence porteuse Fp est modulee par une onde en dent de scie 
de frequence Af. Cette generation de frequence peut etre assuree au niveau de 
Tunite 5 par une diode oscillatrice GUNN. 
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Optionnellement, pour chaque signal Sa, Sb, Sc, remission modulee dure un 
temps limite D. On facilite ainsi la differenciation des signaux regus ainsi que 
I'extraction des informations recherchees. Par ailleurs, en codant la logique de 
repetition des emissions, c'est-a-dire la duree T sur la figure 3, par exemple 
5 selon un modele pseudo-aleatoire, il est possible de personnaliser chacune 
des emissions. On peut ainsi en particulier faire evoluer plusieurs vehicules 
dans le meme environnement. 

Le signal re?u en retour par chaque antenne 2a, 2b, 2c est traite dans une 
io unite de traitement analogique 6a, 6b, 6c respectivement 

Le signal re?u est dephase par rapport au signal emis. Par melange dans 
I'unite 6 correspondante avec une fraction du signal emis, apres elimination de 
la frequence porteuse, un signal de battement £ une frequence type de Tordre 
15 de 1 kHz est obtenu. 

Le signal est tout d'abord filtre pour eliminer les hautes frequences, 
correspondant aux obstacles les plus eloignes. On ne retient ainsi que le signal 
retrodiffuse par le premier obstacle rencontre, qui est ensuite traite par 
20 transformee de Fourrier. 

Par ailleurs, la comparaison de la frequence de Tonde porteuse retrodiffusee et 
de celle de I'onde porteuse du signal emis donne la frequence Doppler F<j qui 
est proportionnelle a la vitesse de rapprochement ou d'eloignernent du vehicule 
25 de Tobstacle detecte, selon la relation : 

v = 1/2^F d 

ou X = c/F (vitesse de propagation/frequence d'emission) 

30 

L'information de vitesse n'est pas necessaire a la mise en oeuvre de 
('invention. Sa disponibilite constitue neanmoins un avantage dans les 
applications. 

35 Les informations de distance et vitesse numerisees sont fournies par les unites 
de traitement analogiques 6a, 6b, 6c au processeur numerique 7. 
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Le processeur 7 est constitue pour I'essentiel d'une unite de calcul susceptible 
d'acceder a une memoire 8. 

A chaque element de la memoire 8 est associee une cellule elementaire 9 de 
Tenvironnement du vehicule. Le contenu de chacun de ses elements de 
memoire represente la probability pour qu'une cellule particuliere, reperee par 
son site <J> et sa distance d par rapport au vehicule, renferme un obstacle. 

La figure 4 represente 2 radars 11 et 12 ayant chacun detecte un obstacle, le 
premier a la distance d-j et le second a la distance d2* Par convention, on 
decide que la probability d'occupation d'une cellule par un obstacle est 
comprise entre -1 (la cellule est certainement non occupee) et +1 (la cellule est 
certainement occupee), la probability p = 0 correspondant a I'incertitude. 

Connaissant la position du foyer de chaque antenne ainsi que son axe de 
visee, on affecte a chaque cellule une probability d'occupation fonction de la 
distance a laquelle un obstacle a ete detecte, de la distance de cette cellule au 
foyer de Tantenne et de I'ecart angulaire entre I'axe de visee de Pantenne et la 
direction de la cellule. A titre d'exemple, la figure 5 represente la fonction de 
repartition des probabilites d'occupation d'une cellule en fonction de sa 
distance au foyer de I'antenne du radar 11, et la figure 6 la fonction de 
repartition des probabilites en fonction de I'ecart angulaire a entre I'axe de 
cetfe antenne et la direction consideree. La probability maximale est bien 
entendu rencontree pour la distance d-| et dans la direction de vise de 
I'antenne. 

Les differentes zones de probabilites sont portees sur les figures 4 a 6. La 
zone B de probability positive sur la figure 5 correspond a deux bandes 
annulaires de part et d'autre du cercle de rayon d-j. On verifie par ailleurs sur 
la figure 5 que seul le premier obstacle rencontre est pris en compte puisqu'au- 
dela d'une certaine distance (zone D) fonction de d-j aucune information n'est 
apportee par la mesure. De meme sur la figure 6, aucune information n'est 
apportee par la mesure en dehors du lobe d'emission (zone A). 
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Les niveaux possibles de quantification entre les valeurs -1 et +1 dependent 
des performances du materiel de calcul utilise, la performance globale de la 
representation de I'environnement etant d'autant meilleure que ces niveaux 
sont plus nombreux. 

Lorsque Ton a de cette maniere affecte a une cellule donnee, par la mesure 
effectuee a I'aide du radar 11, une probability p1 d'occupation de cette cellule 
par un obstacle et, par la mesure effectuee a I'aide du radar 12, une probability 
p2, on met en oeuvre Talgorithme de fusion suivant : 

- si p1 > 0 et p2 > 0. 

F(p1,p2) = p1 + P 2-p1.p2 

- si p1 < 0 et p2 > 0 

F(p1.p2) = p1 +p2 + p1.p2 

- si p1 < 0 et p2 < 0 

p1 +p2 

F(p1,p2) = 

1 -Min (p1,p2) 

Cet algorithme peut etre mis en oeuvre de la fagon decrite ci-dessus, c'est-a- 
dire spacialement, en fusionnant les informations de probability provenant de 
deux radars, ou encore de maniere temporelle. en utilisant reformation de 
probability provenant d'un seul radar et en la fusionnant avec la probability 
deja presente pour la cellule consideree dans la rnemoire 8. 

Les probabilites d'occupation de I'espace s'expriment continument entre -1 
(cellule certainement vide) et +1 (cellule certainement occupee). On realise 
ensuite un seuillage des resultats de la fusion brute de maniere a obtenir une 
carte de I'environnement du vehicule sur laquelle sont portes les obstacles. 
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On peut d'ailleurs ameliorer la representation de cette carte en lui faisant subir 
une operation morphologique de type "fermeture" (dilatation - erosion), connue 
dans le domaine du traitement damage. 

La carte ainsi obtenue fournit ainsi une information precise sur I'environnement 
du vehicule et permet : 

- son evolution avec evitement eventuel d'obstacles ; 

- sa relocalisation par comparaison entre les emplacements mesures des 
obstacles et une connaissance a priori de ces obstacles. 

On peut par ailleurs envisager d'autres systemes emetteurs-recepteurs de 
signaux que le radar, par exemple de telemetres laser ou infrarouge ou des 
sonars. 
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REVENDICATIONS 

1. Procede de detection et de localisation d'obstacles dans I'environnement 
d'un vehicule, caracterise par le fait qu'il comprend les etapes consistant a 
emettre des signaux en direction dudit environnement a partir d'une pluralite de 
radars (2) disposes sur le vehicule, a deduire des signaux regus en echo les 
probabilites d'occupation par un obstacle d'un ensemble de cellules 
elementaires (9) dudit environnement, et a fusionner les probabilites relatives a 
chacune desdites cellules. 

2. Procede selon la revendication 1, dans lequel la fusion est effectuee sur les 
valeurs des probabilites fournies par une pluralite de radars, et notamment 
deux radars. 

3. Procede selon Tune quelconque des revendications 1 et 2, dans lequel la 
fusion est effectuee sur la valeur de la probabilite fournie par un radar et la 
valeur de la probabilite anterieurement connue par la meme cellule. 

4. Procede selon Tune quelconque des revendications 1 a 3, dans lequel on 
deduit, des signaux re?us en echo, une information de distance et une 
information angulaire sur les obstacles, et on determine lesdites probabilites 
d'occupation a partir de ces informations. 

5. Procede selon Tune quelconque des revendications 1 a 4, comprenant une 
etape de seuillage des resuitats de la fusion. 

6. Procede selon Tune quelconque des revendications 1 a 5 ( dans lequel le 
signal emis par les radars est module en frequence, le signal regu en echo est 
melange a une fraction du signal emis pour, apres elimination de la frequence 
porteuse, former un signal de battement, et la distance d'un obstacle est 
obtenue soit par transformation de Fourrier soit par comptage pendant un 
intervalle de temps predetermine. 

7. Procede selon Tune quelconque des revendications 1 a 6, dans lequel 
remission de chaque radar dure un temps limite, et la logique de repetition est 
codee en vue de ridentification de la source. 
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8. Dispositif pour la detection et la localisation ^obstacles dans 
Tenvironnement d'un vehicule, caracterise par le fait qu'il comprend une 
pluralite de radars (2) montes sur le vehicule et une unite de traitement (7) 
agencee pour fusionner les donnees fournies par les radars. 

9. Dispositif selon la revendication 8, dans lequel les radars sont a lobe large. 
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